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Abstract — In this paper we study a discrete variational 
optimal control problem for the rigid body. The cost to be 
minimized is the external torque applied to move the rigid 
body from an initial condition to a pre-specifled terminal con- 
dition. Instead of discretizing the equations of motion, we use 
the discrete equations obtained from the discrete Lagrange- 
d'Alembert principle, a process that better approximates the 
equations of motion. Within the discrete-time setting, these 
two approaches are not equivalent in general. The kinematics 
are discretized using a natural Lie-algebraic formulation that 
guarantees that the flow remains on the Lie group S0(3) and 
its algebra so (3). We use Lagrange's method for constrained 
problems in the calculus of variations to derive the discrete- 
time necessary conditions. We give a numerical example for a 
three-dimensional rigid body maneuver. 

I. Introduction 

This paper deals with a structure-preserving computa- 
tional approach to the optimal control problem of mini- 
mizing the control effort necessary to perform an attitude 
transfer from an initial state to a prescribed final state, in 
the absence of a potential field. The configuration of the 
rigid body is given by the rotation matrix from the body 
frame to the spatial frame, which is an element of the group 
of orientation-preserving isometrics in M.^. The state of the 
rigid body is described by the rotation matrix and its angular 
velocity. 

To motivate the computational approach we adopt in 
the discrete-time case, we first revisit the variational 
continuous-time optimal control problem. The continuous- 
time extremal solutions to this optimal control problem have 
certain special features, since they arise from variational 
principles. General numerical integration methods, includ- 
ing the popular Runge-Kutta schemes, typically preserve 
neither first integrals nor the characteristics of the configura- 
tion space. Geometric integrators are the class of numerical 
integration schemes that preserve such properties, and a 
good survey can be found in [1]. Techniques particular to 
Hamiltonian systems are also discussed in [2] and [3]. 

Our approach to discretizing the optimal control problem 
is in contrast to traditional techniques such as collocation, 
wherein the continuous equations of motion are imposed as 
constraints at a set of collocation points. In our approach, 
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modeled after [4], the discrete equations of motion are de- 
rived from a discrete variational principle, and this induces 
constraints on the configuration at each discrete time step. 

This approach yields discrete dynamics that are more 
faithful to the continuous equations of motion, and conse- 
quently yields more accurate numerical solutions to the op- 
timal control problem. This feature is extremely important 
in computing accurate (sub)optimal trajectories for long- 
term spacecraft attitude maneuvers. For example, in [5], the 
authors propose an imaging spacecraft formation design that 
requires a continuous attitude maneuver over a period of 
77 days in a low Earth orbit. Hence, the attitude maneuver 
has to be very accurate to meet tight imaging constraints 
over long time ranges. The proposed variational scheme can 
also be easily extended to other types of Lie groups. For 
example, in long range inter-planetary orbit transfers (see, 
for example, [6]), one is interested in computing optimal or 
suboptimal trajectories on the group of rigid body motions 
SE(3) with a high degree of accuracy. Similar requirements 
also apply to the control of quantum systems. For example, 
efficient construction of quantum gates is a problem on 
the unitary Lie group SU(A^). This is an optimal control 
problem, where one wishes to steer the identity operator to 
the desired unitary operator (see, for example, [7] and [8]). 

Moreover, an important feature of the way we discretize 
the optimal control problem is that it is S0(3)-equivariant. 
This is desirable, since it ensures that our numerical results 
are independent of the choice of coordinates and coordinate 
frames. This is in contrast to methods based on coordi- 
natizing the rotation group using quaternions, (modified) 
Rodrigues parameters, and Euler angles, as given in the 
survey [9]. Even if the optimal cost function is S0(3)- 
invariant, as in [10], the use of generalized coordinates 
imposes constraints on the attitude kinematics. 

For the purpose of numerical simulation, the correspond- 
ing discrete optimal control problem is posed on the discrete 
state space as a two stage discrete variational problem. 
In the first step, we derive the discrete dynamics for the 
rigid body in the context of discrete variational mechanics 
[11]. This is achieved by considering the discrete Lagrange- 
d'Alembert variational principle [12] in combination with 
essential ideas from Lie group methods [13], which yields a 
Lie group variational integrator [14]. This integrator explic- 
itly preserves the Lie group structure of the configuration 
space, and is similar to the integrators introduced in [15] 
for a rigid body in an external field, and in [16] for full 
body dynamics. These discrete equations are then imposed 
as constraints to be satisfied by the extremal solutions to the 



discrete optimal control problem, and we obtain the discrete 
extremal solutions in terms of the given terminal states. 

The paper is organized as follows. As motivation, in Sec- 
tion II, we study the optimal control problem in continuous- 
time. In Section III, we study the discrete-time case. In 
particular, in Section III-A we state the optimal control 
problem and describe our approach. In Section III-B, we de- 
rive the discrete-time equations of motion for the rigid body 
starting with the discrete Lagrange-d'Alembert principle. 
These equations are used in Section III-C for the optimal 
control problem. In Section IV, we describe an algorithm for 
solving the general nonlinear, implicit necessary conditions 
for S0(3) and give numerical examples for rest-to-rest and 
slew-up spacecraft maneuvers. 

II. Continuous-Time Results 

A. Problem Formulation 

In this paper, the natural pairing between so* (3) and 
so(3) is denoted by (•,•). Let <C •, • » and <C •,• ^* 
denote the standard (induced by the Killing form) inner 
product on so (3) and so* (3), respectively. The inner product 
^ •,• ^* is naturally induced from the standard norm 
<C|,u; for all e so(3), through 

= <$,a;», (1) 
where = a;^ e so* (3) and 77 = G so* (3), with £ 
so(3) and b and (J are the musical isomorphisms (see §2.5 of 
[17]) with respect to the standard metric <C •, • On so(3), 
these isomorphisms correspond to the transpose operation. 
That is, we have ip = up- and 77 = ^ . 

Let J : so (3) so* (3) be the positive definite inertia 
operator. It can be shown that 

{3{i),u,) = {3{u),i) . (2) 
On so (3), J is given by J(^) = J$ + ^J, where J is a 
positive definite symmetric matrix (see, for example, [17], 
[18]). Moreover, we also have 3{ri^)^ = {Jrf + rfJ)^ = 
J(t7), which is an abuse of notation since t] G so* (3). For 
the sake of generality and mathematical accuracy, we will 
use the general definitions, though it is helpful to keep the 
above identifications for so (3) in mind. 

In this section we review some continuous-time optimal 
control results using a simple optimal control example on 
S0(3). Here, we minimize the norm squared of the control 
torque t e so* (3) applied to rotate a rigid body subject 
to the Lagrange-d'Alembert principle for the rigid body' 
whose configuration is given by R G S0(3) and body 
angular velocity is given by $7 € so(3). We require that the 
system evolve from an initial state (Rg, flo) to a final state 
(Rt, J^t) at a fixed terminal time T. Hence, we have the 
following minimum control effort optimal control problem. 

'This is equivalent to constraining the problem to satisfy the rigid body 
equations of motion given by equations (7). However, for the sake of 
generality that will be appreciated in the discrete-time problem, we choose 
to treat the Lagrange-d'Alembert principle as the constraint as opposed to 
the rigid body equations of motion. Both are equivalent in the continuous- 
time case but are generally not equivalent in the discrete-time case. 



Problem 2.1: Minimize 

1 F 

J ^ 7; ^r,T:$>,dt (3) 
^ Jo 

subject to 

1) satisfying Lagrange-d'Alembert principle: 

sf l-{j{n),n)dt+ f (T,w)dt = o, (4) 

Jo , Jo 
subject to R = Rr2, where W is the variation vector 

field to be defined below, 

2) and the boundary conditions 

R(o) = Ro, n{o) = no, 

R(r) = Rt, n(T) = riT- (5) 

We now show that this is equivalent to the following 
problem formulation, where the rigid body equations of 
motion replace the Lagrange-d'Alembert principle. 

Problem 2.2: Minimize 
1 

J = - / < r,T >, di (6) 
^ Jo 

subject to 

1) the dynamics 

R = Rfl (7) 
M = ad^M + r = [M, + r, 
where M = J {ft) £ so* (3) is the momentum, 

2) and the boundary conditions 

R(0) = Ro, 0(0) = Oo, 

R(r) = Rt, rj(r) = Ot. (8) 

In the above, ad* is the dual of the adjoint representation, 
ad, of so(3) and is given by ad|r7 = — t]] G so* (3), for 
all I e so(3) and ij G so*(3). Recall that the bracket is 
defined by uj] = ^u) — uj^. 

B. The Lagrange-d'Alembert Principle and the Rigid Body 
Equations of Motion 

In this section we derive the forced rigid body equations 
of motion (equations (7)) from the Lagrange-d'Alembert 
principle. In dealing with the kinematic constraint, R = 
RO, we may either append it to the Lagrangian using the 
method of Lagrange multipliers, or we can directly compute 
the constrained variations (see §13.5 of [19]). Here, we take 
the direct approach as it yields a more concise derivation. 

First, we take variations of the kinematic condition O = 
R^R to obtain dVL = -R ^ (5R) R^^R + R MR. As 
defined previously, we have W = R~^(5R and, therefore, 
W = R iRR MR + R MR = OW + R MR, 
since JR = ^^R (see [20], p. 52). Hence, we have 

dVl = -WO + OW + W = adoW + W. (9) 
Taking variations of the Lagrange-d'Alembert principle we 
obtain ^ 

/ (J(0),^0) + (T,W)dt = 0. 
Jo 

Using the variation in equation (9) and integrating by parts, 
we obtain 

= j (-M + ad^,M + T, W) dt + [(J (O) , W(t))];^ , 

where we have used the property 
(r?,ad^O = (ad^r?,!), »7eso*(3), u;,^eso(3). (10) 



This gives the desired resuh, with M = J ($1). 

C. Continuous-Time Variational Optimal Control Problem 

A direct variational approach is used here to derive the 
necessary conditions for the optimal control Problem (2.2). 

A Second Order Direct Approach. "Second order" is 
used here to reflect the fact that we now study variations 
of second order dynamical equations as opposed to the 
kinematic direct approach studied in Section II-B. We 
now give the resulting necessary conditions using a direct 
approach as in [19]. We already computed the variations 
of R and Jl. These were as follows: 5H. = RW and 
Sfl ~ adoW + W. We now compute the variation of M 
with the goal of obtaining the proper variations for t: 

where TZ is the curvature tensor on SO(3). The curvature 
tensor TZ arises due to the identity (see [20], page 52) 

where Y € TS0(3) is any vector field along the curve 
R(t) e S0(3). Taking variations of M = ad^M + r we 
obtain SM = ad^^M + ad^SM + St. We now have flie 
desired variation in t: 

St = J {n{W,n)fl) + -^3 {S ft) -adg^M 



dt 



-ad^^M. 



(11) 



Take variations of the cost functional (6) to obtain: 

SJ = I^ (J(0 - ad^ (J(0) + ^ - ^ (ad:M) 

+ [TZ (J(^)«, n)n]' + ad^ad*M - adj^r,, W)dt, 
where ^ = e so(3) and 77 = J (ado^) € so* (3). Here, 
we used integration by parts and the boundary conditions 

(7) , equations (9) and (11), and the identities (1), (2) and 
(10). Hence, we have the following theorem. 

Theorem 2.1: The necessary optimality conditions for 
the problem of minimizing (6) subject to the dynamics (7) 
and the boundary conditions (8) are given by the single 
fourth order^ differential equation 

= J(^-)-ad^(J(^))+77-^(ad*M) 

+ [tZ ((J(^))« , ' + ad^j (ad*M) - ad^r?, 

as well as the equations (7) and the boundary conditions 

(8) , where ^ and r] are as defined above. 

To obtain above result we used the initial conditions (8), 
and the fact that the vector fields Vl and W are left-invariant 
vector fields. The curvature tensor is evaluated at a point 
R(<) ^ I. That is, we get 7^R^ ^) O. Evaluating 

this at e = we get: 7^R (RW, RSI) VI. Since RW and 
Rr2 are left-invariant vector fields at the group element 
R(t), by the identification TrS0(3) ~ so(3), we have 
7^R (RW, Rrj) n = n (W, n) O, which is the curvature 
tensor evaluated at the identity element. For a compact 
semi-simple Lie group G with Lie algebra g, the curvature 

'Second order in x and fourth order in R. 



tensor, with respect to a bi-invariant metric, is (see [20]): 

7^(X,Y)Z = iadadxYZ, (12) 
for ah X,Y,Z e g. 

Using a Lagrange multiplier approach, we obtain instead 
the following theorem. 

Theorem 2.2: The necessary optimality conditions for 
the problem of minimizing (6) subject to the dynamics (7) 
and the boundary conditions (8) are given by 

T = A.2 



Ai = 



7^ j(A2)»,nm 



A2 = -J ^ (Ai) - adnA2 



- ad^Ai 
J-i fad*. 



(13) 



M) 



and the equations (7) and the boundary conditions (8). The 
Lagrange multipliers Ai e so* (3), A2 G so(3) correspond 
to the kinematic and dynamics constraints (7), respectively. 

Remark 2.1: Note that the equations of motion that arise 
from the Lagrange-d'Alembert principle are used to define 
the dynamic constraints. In effect, we minimize J' subject to 
satisfying the Lagrange-d'Alembert principle. Analogously, 
the discrete version of the Lagrange-d'Alembert principle 
will be used to derive the discrete equations of motion in 
the discrete optimal control problem to be studied in Section 
III-C. This view is in line with the approach in [4] in that 
we do not discretize the equations of motion directly, but, 
instead, we discretize the Lagrange-d'Alembert principle. 
These two approaches are not equivalent in general. 

Corollary 2.1: The necessary optimality conditions of 
Theorem 2.1 are equivalent to those of Theorem 2.2. 
Proof. In Theorem 2.2, differentiate A2 once and then use 
all three differential equations to replace Ai and A2 with 
expressions involving only r, M and ft. ■ 

III. Discrete-Time Results 
A. Problem Formulation 

In this section we give the discrete version of the problem 
introduced in Section II-A. So, we consider minimizing the 
norm squared of the control torque r subject to satisfaction 
of the discrete Lagrange-d'Alembert principle for the rigid 
body whose configuration and body angular velocity at 
time step tk are given by Rfc e S0(3) and fifc G so(3), 
respectively. The kinematic constraint may be expressed as 
Rfc+i = Rfc exp (/iHfc) = Rfegfc, (14) 
where h is the integration time step, cxp : so(3) S0(3) 
is the exponential map and = cxp(/iJlfc). The boundary 
conditions are given by (Rq, Oq) and (R^, where 
<o = and iV = T/h is such that tjs = T. 

The reason we constrain Jl at t = h{N — 1) instead of 
at i = hN is that a constraint on Vlk E so (3) corresponds, 
by left translations to a constraint on R^. G Tr^S0(3). In 
turn, in the discrete setting and depending on the choice 
of discretization, this corresponds to a constraint on the 
neighboring discrete points. With our choice of discretiza- 
tion (equation (14)), this corresponds to constraints on R^ 
and Rfc+i. Hence, to ensure that the effect of the terminal 
constraint on O is correctly accounted for, the constraint 



must be imposed on Jljv-i, which entails some constraints 
on variations at both Rtv^i and Rat. We will return to this 
point later in the paper. 

Equation (14) is just one way of discretizing the kine- 
matics of the rigid body. In the case of planar rigid body 
dynamics, this leads to the first-order Euler approximation. 
However, on S0(3), our approach yields a novel discretiza- 
tion. We make the above choice for discretization as it 
guarantees, in general, that the angular velocity matrix O^. 
remains on the algebra so (3) by using the exponential map. 
This is natural to do in the context of discrete variational 
numerical solvers (for both initial value and two point 
boundary value problems). Following the methodology of 
[4], we have the following optimal control problem. 

Problem 3.1: Minimize 



N 



1 



J = 2^2^^^'^^»* ^^^^ 

A:=0 

subject to 

1) satisfying the discrete Lagrange-d'Alembert princi- 
ple: 

N-l N 

-(J(flfc),Ofe)+^(xfc,W,) =0, (16) 

fe=0 k=0 

subject to Ro = Rq, Rn = Rfe+i = R^gfe, 

k = 0,1, . . . , N— 1, where is the variation vector 
field at time step tk satisfying <5Rfc = R^W^, 

2) and the boundary conditions 



Rn 



Rat = R^, Ojv-i = f^iv-i- 
The following formulation is equivalent, where the dis- 
crete rigid body equations of motion replace the Lagrange- 
d'Alembert principle constraint. 



^0, 



Problem 3.2: Minimize 

N 



J 



(18) 



fc=0 



subject to 

1) the discrete dynamics 

Rfc+i=Rfcgfc, fc = 0,...,7V-l 
Mk = Ad;^ (hTk + Mfc_i) , fc = 1, 
Mfc = J(f2fc), k = 0,...,N-l, 

2) and the boundary conditions 



Ro 
Rn 



Rqj ^0 — S^o 



N-l- 



,N-l, 
(19) 

(20) 



Regarding terminal velocity conditions, note that in the 
second of equations (19) if we let fc = we find that 
Hjv appears in the equation. A constraint on Oat dictates 
constraints at the points Rjv and Rw+i through the first 
equation in (19). Since we only consider time points up to 
t = Nh, we can not allow fc = A^ in the second of equations 
(19) and hence our terminal velocity constraints are posed 
in terms of JIa^-i instead of n^. 

As mentioned above, is a variation vector field 

associated with the perturbed group element R|. Likewise, 
we need to define a variation vector field associated with the 



element = cxp(/ir2fc). First, let the perturbed variable 
g| be defined by 

gfc = gfcexp(eMrjfc), (21) 

where 

sn 



Note that g| | ^ ^ — gk as desired. Moreover, we have 

(Jgfe = SklhSilk) expiehSn^)]^^^ = hgkSQk. (22) 
This will be needed later when taking variations. 

B. The Discrete Lagrange-d'Alembert Principle and the 
Rigid Body Equations of Motion 

In this section we derive the discrete forced rigid body 
equations of motion (equations (19)) starting with the 
discrete Lagrange-d'Alembert principle. As in the contin- 
uous case, we will compute the constrained variation of 
dVLk- We begin by rewriting the kinematic constraint as 
exp~^ (RjT^Rfc+i) = hQ,k, which is easier to handle as an 
expression over the Lie algebra. Take variations to obtain, 
-Rfci (<5Rfe)Rj:iRfe+i + Rfeimfc+i = hgk-Snu, which 
is equivalent to -Wfcgfc + gfeW^+i = /igfe^rj^, or 



1 



(23) 



-Ad -iWfc+Wfe+i 

/t L ^& J 

Note that this is an expression over the Lie algebra so(3). 
Taking direct variations of the cost functional we obtain 

= / To - iAd*-iJ(flo),Wo 



tn 



N-l 

E 

fe=i 



1 



J(f7 



w 



N 



-Ad*-iJ 
h 



-J(Ofc_i),Wj 



where we have used equation (23). By the boundary con- 
ditions Ro = Rq and Rat = R^, we have Wq = and 
Wat = 0. Since W^, k — 1, . . . ,N — 1, are arbitrary and 
independent, we obtain the equivalent of equations (19). 

C. Discrete-Time Variational Optimal Control Problem 

Analogous to the direct approach in continuous time, 
here we derive the necessary optimality conditions in a 
form that does not involve the use of Lagrange multipliers. 
Using equation (23) and taking variation of the second of 
equations (19), we obtain 

8Tk = Ad*-i(^^jfWfe+i- Ad^-iWfc' 

1 r 

__Lj(w.-Ad^-. W._i), (24) 
for k = l,...,iV — 1. Taking variations of the cost 
functional (18) and using equation (24), one obtains after a 
tedious but straightforward computation an expression for 
5J in terms of STk, which we omit because of space 
restrictions. When 8J is equated to zero, the resulting 
equation gives (boundary) conditions on xo, ti, tat-i, tat 
as well as discrete evolution equations that are written in 



/l2 

Wfc+i - Ad -iWfe,j(jifc; 

Wfe - Ad -1 Wfc-i) , 



algebraic nonlinear form as: 
1 



J(r».)-Ad*-.j(4^,) 



/l2 

-J fAd-i r 



Ad* 



J(flfe),Adg-i (r 



fc-i 



(25) 



4' 

1 r, 

for fc = 2, . . . , TV - 2. 

A Lagrange multiplier approach yields the following 
equivalent theorem. 

Theorem 3.1: The necessary optimality conditions for 
the discrete Problem 3.2 are 

Rfe+i = Rfcgfe, k^l,...,N^2 
Mfc = Ad*j;iTfe + Mfe_i), fc = l,...,7V- 
= Ati-Ad* ,Ai, fc = 2,...,iV-2 



1 







Tfe 

Mfe 



-Al+J{Al) 



J(Adg,+,A; 



+/i[Mfe,A2], fc = l,. 
/^(Adg,A2)^ fc = l,. 
J(nfe), fc = 0,...,7V- 



fe+i) 
,7V- 2 

,A^- 1 



(26) 



1, 



and the boundary conditions 

Rat = R^, Rat-i = Rjv {Sn~i) 

To = TN = 0, 

where gj^ = exp(/ir2*) and g^^^ = exp (/ifi^.-^). 

IV. Numerical Approach and Results 

The first-order optimality equations, equation (25), in 
combination with the boundary conditions. 



Rn 



R^v — R 



J7o = rip, and rijv-i = 



leave the torques Ti, . . . , XAr_i, and the angular velocities 
fli, . . . , flN-2 as unknowns. By substituting the relations 
gk = cxp{hflk), Mfc = 3{flk), we can rewrite the 
necessary conditions (25) as follows. 



/ir2fc)J('^fc+i) 
J(Adoxp(_/ir!fc_i)'r[._i 



J (Ad, 



cxp(-hr2fc)~fe 



)) 



1 



1 



J(r2fc),Adexp(-/ir!,)(-ry 
J(nfc_i),Adc^p(_hf^,_^)(r|^_^) ) 



where k = 2, . . . , iV — 2, and the discrete evolution 
equations, given by line 2 of (26), can be written as 

- Ad:,p(,,o,)(/iT, + 3in„^i)), 

where k = 1, . . . , N — 1. In addition, we use the boundary 
conditions on Rq and Rat, together with the update step 
given by line 1 of (26) to give the last constraint, 

= log (^R^^Ro exp(/ino) . . . exp^hUN-ifj , 






~V3 


V2 







-Vi 


-V2 


Vi 






where log is the logarithm map on S0(3). 

At this point it should be noted that one important 
advantage of the manner in which we have discretized the 
optimal control problem is that it is S0(3)-equivariant. This 
is to say that if we rotated all the boundary conditions by 
a fixed rotation matrix, and solved the resulting discrete 
optimal control problem, the solution we would obtain 
would simply be the rotation of the solution of the original 
problem. This can be seen quite clearly from the fact that the 
discrete problem is expressed in terms of body coordinates, 
both in terms of body angular velocities and body forces. 
In addition, the initial and final attitudes Rq and Rjv only 
enter in the last equation as a relative rotation. 

The S0(3)-equivariance of our numerical method is 
desirable, since it ensures that our results are independent 
of the choice of coordinate frames. This is in contrast to 
methods based on coordinatizing the rotation group using 
quaternions and Euler angles. 

The equations above take values in so (3). Consider the 
Lie algebra isomorphism between K'^ and so(3) given by. 



V = {vi,V2,V3) 



which maps 3-vectors to 3 x 3 skew-symmetric matrices. In 
particular, we have the following identities, 

[u,v] = (u X v)", AdAV = (Av)". 
Furthermore, we identify so (3)* with R'^ by the usual dot 
product, that is to say if H, v e M'^, then (11, v) = 11 • v. 
With this identification, we have that Ad^-in = AH. 
Using the identities above, we write the necessary condi- 
tions using matrix- vector products and cross products. Then, 
each of the equations can be interpreted as 3-vector valued 
functions, and the system of equations can be considered as 
a 3(2 A^— 3)-vector valued function, which is precisely the 
dimensionality of the unknowns. This reduces the discrete 
optimal problem to a nonlinear root finding problem. 

We used a Newton-Armijo method, a line search algo- 
rithm that uses the Newton search direction, and backtrack- 
ing to ensure sufficient descent of the residual error The 
Jacobian is constructed column by column, where the fc-th 
column is computed using the following approximation, 

— X = - Im F x + ieefc , 
oxk e 

where i = a/— T, is a basis vector in the Xk direction, 
and e is of the order of machine epsilon. This method is 
more accurate than a finite-difference approximation as it 
does not suffer from round-off errors. 

In our numerical simulation, we computed an optimal 
trajectory for a rest-to-rest maneuver, as illustrated in Figure 
(1). In this simulation N = 128, and essentially identical 
results were obtained for N = 64. It is worth noting that 
the results are not rotationally symmetric about the midpoint 
of the simulation interval, which is due to the fact that our 
choice of update, Rfe+i = R^ cxp(/iJlfc), does not exhibit 
time-reversal symmetry. In a forthcoming publication, we 
will introduce a reversible algorithm to address this issue. 
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Fig. 1. Discrete optimal rest-to-rest maneuver in S0(3). 
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Fig. 2. Discrete optimal slew-up maneuver in S0(3). 

We also present results for an optimal slew-up maneuver 
in T = 12.8 seconds from zero initial angular velocity to 
a final angular velocity of 0^ = [0.3 0.2 0.3]^, illustrated 
in Figure (2). The resolution is iV = 128, and essentially 
identical results were obtained for = 64. 

V. Conclusion 

In this paper we studied the continuous- and discrete- 
time optimal control problem for the rigid body, where 
the cost to be minimized is the external torque applied 
to move the rigid body from an initial condition to some 
pre-specified terminal condition. In the discrete setting, we 
use the discrete Lagrange-d'Alembert principle to obtain 
the discrete equations of motion. The kinematics were 
discretized to guarantee that the flow in phase space remains 
on the Lie group S0(3) and its algebra so(3). We described 
how the necessary conditions can be solved for the general 
three-dimensional case and gave a numerical example for a 
three-dimensional rigid body maneuver. 

Currently, we are investigating the connections with Pon- 
tryagin's maximum principle in continuous- and discrete- 
time. Additionally, we wish to generalize the result to 
general Lie groups with applications other than rigid body 
motion on S0(3). In particular, we are interested in control- 



ling the motion of a rigid body in space, which corresponds 
to motion on the non-compact Lie group SE(3). 
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